#!/usr/bin/env python3

import rospy
import DrEmpower as dr

def motor_control():
    # 初始化 ROS 节点
    rospy.init_node('home', anonymous=True)

    '''多个绝对角度控制'''
    dr.set_angles(id_list=[1,2,3,4,5,6], angle_list=[0,0,0,0,0,0], speed=2, param=10, mode=1)

 

if __name__ == '__main__':
    try:
        motor_control()
    except rospy.ROSInterruptException:
        rospy.logerr("ROS 中断异常")

